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Abstract:  Significant  research  has  been  aimed  at  the  development  and  control  of  teleoperator 
systems  due  to  both  the  practical  importance  and  the  challenging  theoretical  nature  of  the  problem. 
Two  controllers  are  developed  in  this  paper  for  a  nonlinear  teleoperator  system  that  target  coordi¬ 
nation  of  the  master  and  slave  manipulators  and  passivity  of  the  overall  system.  The  first  controller 
is  proven  to  yield  a  semi-global  asymptotic  result  in  the  presence  of  parametric  uncertainty  in  the 
master  and  slave  manipulator  dynamic  models.  The  second  controller  yields  a  global  asymptotic 
result  despite  unmeasurable  user  and  environmental  input  forces.  To  develop  each  controller,  a 
transformation  encodes  the  coordination  and  passivity  objectives  in  the  closed  loop  system.  The 
coordinated  system  is  forced  to  track  a  dynamic  system  to  assist  in  meeting  all  control  objectives. 
Finally,  continuous  nonlinear  integral  feedback  terms  are  used  to  accommodate  for  incomplete  sys¬ 
tem  knowledge  for  both  controllers.  Lyapunov-based  techniques  are  used  to  prove  that  all  control 
objectives  are  met  and  that  all  signals  are  bounded. 

1  Introduction 

A  teleoperator  system  consists  of  a  user  interacting  with  some  type  of  input  device  (i.e.,  a  master 
manipulator)  with  the  intention  of  imparting  a  predictable  response  by  an  output  system  (i.e.,  a  slave 
manipulator).  Significant  research  has  been  aimed  at  the  development  and  control  of  teleoperator 
systems  due  to  both  practical  importance  and  the  challenging  theoretical  nature  of  this  human- 
robot  interaction  problem.  Practical  applications  of  teleoperation  are  motivated  by  the  need  for 
task  execution  in  hazardous  environments  (e.g.,  contaminated  facilities,  space,  underwater),  the 
need  for  remote  manipulation  due  to  the  characteristics  of  the  object  (e.g.,  size  and  mass  of  an 
object,  hazardous  nature  of  the  object),  or  the  need  for  precision  beyond  human  capacity  (e.g., 
robotic  assisted  medical  procedures).  The  teleoperator  problem  is  theoretically  challenging  due 
to  issues  that  impact  the  user’s  ability  to  impart  a  desired  motion  and  a  desired  force  on  the 
remote  environment  through  the  coupled  master-slave  system.  Some  difficult  issues  include  the 
presence  of  uncertainty  in  the  master  and  slave  dynamics,  the  ability  to  accurately  model  or  measure 
environmental  and  user  inputs  to  the  system,  the  ability  to  safely  reflect  desired  forces  back  to  the 
user  while  mitigating  other  forces,  and  the  stability  of  the  overall  system  (e.g.,  as  stated  in  [14],  a 

*This  work  is  supported  in  part  by  two  DOC  Grants,  an  ARO  Automotive  Center  Grant,  a  DOE  Contract,  a 
Honda  Corporation  Grant,  and  a  DARPA  Contract. 
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stable  teleoperator  system  may  be  destabilized  when  interacting  with  a  stable  environment  due  to 
coupling  between  the  systems). 

The  emphasis  of  some  previous  related  research  is  to  achieve  ideal  transparency  by  exactly  trans¬ 
ferring  the  slave  robot  impedance  to  the  user.  Typically,  approaches  that  aim  for  ideal  transparency 
either  require  a  priori  knowledge  of  the  environmental  inputs  to  the  slave  manipulator,  as  in  [4],  or 
estimate  the  impedance  of  the  slave  manipulator  as  in  [6].  Some  exceptions  include  the  t-eleopera- 
t-or  controllers  aimed  at  low-frequency  transparency  developed  in  [11]  and  [23]  that  do  not  require 
knowledge  of  the  impedance  of  the  user  or  environment.  However,  the  approaches  in  [4],  [6],  [11], 
and  [23]  are  based  on  linear  teleoperator  systems  with  frequency- based  control  designs.  A  review 
of  other  frequency-based  approaches  applied  to  linear  t-eleoperat-or  systems  are  given  in  [1],  [8],  [9], 
[22],  and  [25].  In  [7],  an  adaptive  nonlinear  control  design  is  presented  that  achieves  transparency 
in  the  sense  of  motion  and  force  tracking. 

Other  research  has  emphasized  the  stability  and  safe  operation  of  the  teleoperator  system 
through  passivity  concepts  (e.g.,  [l]-[3],  [12]- [14] ,  and  [17]- [19] ) .  In  [1],  Anderson  and  Spong  used 
passivity  and  scattering  criterion  to  propose  a  bilateral  control  law  for  a  linear  time-invariant  tele¬ 
operator  system  in  any  environment  and  in  the  presence  of  time  delay.  These  results  were  then 
extended  in  [18]  and  [19],  where  wave- variables  were  used  to  define  a  new  configuration  for  force- 
reflecting  teleoperators.  In  [19],  and  more  recently  in  [2]  and  [3],  these  methods  where  extended 
to  solve  the  position  tracking  problem.  In  [14],  a  passivity-based  approach  was  used  to  develop  a 
controller  that  renders  a  linear  t-eleoperat-or  system  as  a  passive  rigid  mechanical  tool  with  desired 
kinematic  and  power  scaling  capabilities.  The  development  in  [14]  was  extended  to  nonlinear  tele- 
operator  systems  in  [12]  and  [13].  The  controllers  in  [12]  and  [13]  are  dependent  on  knowledge  of 
the  dynamics  of  the  master  and  slave  manipulator  and  force  measurements. 

In  comparison  to  the  previous  literature,  two  controllers  are  developed  in  this  paper  for  nonlinear 
t-eleoperat-or  systems  that  target  coordination  of  the  master  and  slave  manipulators  as  well  as 
passivity  of  the  overall  system.  The  first  controller  is  proven  to  yield  a  semi-global  asymptotic 
result  in  the  presence  of  parametric  uncertainty  in  the  master  and  slave  manipulator  dynamic 
models  provided  the  user  and  environmental  input  forces  are  measurable;  henceforth,  referred  to  as 
the  MIF,  (measurable  input  force)  controller.  The  second  controller  yields  a  global  asymptotic  result 
despite  unmeasurable  user  and  environmental  input  forces  (UMIF)  provided  the  dynamic  models 
of  the  respective  manipulators  are  known.  The  novelty  in  developing  each  controller  resided  in  the 
three  following  steps.  The  first  utilizes  a  transformation  which  encodes  both  the  coordination  and 
passivity  objectives  within  the  closed  loop  system.  Next,  a  dynamic  trajectory  generating  system  is 
designed  which  assists  in  achieving  overall  system  passivity  as  well  as  keeping  all  signals  bounded  in 
the  closed  loop  system.  Finally,  a  continuous  nonlinear  integral  feedback  observer  (see  [20]  and  [24]) 
is  exploited  to  compensate  for  the  lack  of  system  dynamics  information  or  user  and  environmental 
force  measurements.  For  each  controller,  Lyapunov-based  techniques  are  used  to  prove  that  these 
three  steps  develop  a  stable  passively  coordinated  t-eleoperator  system. 

The  controllers  developed  in  this  work  utilize  the  nonlinear  dynamic  model  which  offers  a  clear 
advantage  over  past  results  for  linear  t-eleoperator  systems  ([4],  [6],  [11],  and  [23]).  The  MIF 
controller  developed  in  Section  3  compensates  for  unknown  system  parameters,  which  offers  an 
improvement  over  past-  works  that  require  exact-  model  knowledge  (i.e.  [4]  and  [6]).  The  UMIF 
controller  developed  in  Section  4  compensates  for  unavailable  force  measurement,  which  offers  an 
improvement  over  works  that  requires  force  measurements  (i.e.  [12]  and  [13]).  Numerical  simulation 
results  are  presented  for  each  controller  in  Sections  3.4  and  4.4,  respectively. 
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2  System  Model 

The  dynamic  model  for  a  2n-D0F  nonlinear  teleoperator  consisting  of  a  revolute  n-DOF  master 
and  a  revolute  n-DOF  slave  revolute  robot  are  described  by  the  following  expressions  [12] 

7  {Mi(gi(f))g'i(£)  +  C^q^t),  9i(t))gi(t)  +  B^t)  =  T^t)  +  F\(t)}  (1) 

M2(q2(t))q2(t)  +  C2(q2(t),  Q2(t))q2(t)  +  B2q2(t)  =  T2(t)  +  F2(t).  (2) 

In  (1)  and  (2),  7  6  M  denotes  a  positive  adjustable  power  scaling  term,  qt(t),  <ji(t),  qt(t)  G  denote 
the  link  position,  velocity,  and  acceleration,  respectively,  Vi  =  1,2  where  i  =  1  denotes  the  master 
manipulator  and  i  =  2  denotes  the  slave  manipulator,  Mj(gj)  G  Mnxn  represents  the  inertia  effects, 
Ci(qi,<ji )  G  Mnxn  represents  centripetal-Coriolis  effects,  Bi  G  Mnxn  represents  the  constant  positive 
definite,  diagonal  dynamic  frictional  effects,  Tt(t)  G  M"  represents  the  torque  input  control  vector, 

Fi(t)  G  Mn  represents  the  user  input  force,  and  F2(t)  G  W1  represents  the  input  force  from  the 

environment.  The  subsequent  development  is  based  on  the  property  that  the  master  and  slave 
inertia  matrices  are  positive  definite  and  symmetric  in  the  sense  that  [15] 

mu  ||£||2  <  <  m2i  ||{||2  (3) 

G  IF  and  i  =  1,2  where  mu,  m2l  G  M  are  positive  constants,  and  ||-||  denotes  the  Euclidean 
norm.  The  subsequent  development  is  also  based  on  the  assumption  that  qi(t),  <ji(t )  are  measurable, 
and  that  the  inertia  and  centripetal-Coriolis  matrices  are  second  order  differentiable. 

3  MIF  Control  Development 

For  the  MIF  controller  development,  the  subsequent  analysis  will  prove  a  semi-global  asymptotic 
result  in  the  presence  of  parametric  uncertainty  in  the  master  and  slave  manipulator  dynamic  models 
provided  the  user  and  environmental  input  forces  are  measurable.  This  development  requires  the 
assumption  that  Fj(f),  Fi(t),  Fit )  G  L ^  Vi  =  1,2  (precedence  for  this  type  of  assumption  is 
provided  in  [12]  and  [14]). 

3.1  Objective  and  Model  Transformation 

One  of  the  two  primary  objectives  for  the  bilateral  teleoperator  system  is  to  ensure  coordination 
between  the  master  and  the  slave  manipulators  in  the  following  sense 

<72 (t)  — ►  qi(t)  as  t  —>  00.  (4) 

The  other  primary  objective  is  to  ensure  that  the  system  remains  passive  with  respect  to  the  scaled 
user  and  environmental  power  in  the  following  sense  [12] 

[  {10i(t)Fi(t)  +  q2  (r)F2(r))dr  >  -c?  (5) 

j  to 

where  c\  G  R  is  a  bounded  positive  constant,  and  7  was  introduced  in  (1).  The  passivity  objective 
is  included  in  this  section  to  ensure  that  the  human  can  interact  with  the  robotic  system  in  a 
stable  and  safe  manner,  and  that  the  robot  can  also  interact  with  the  environment  in  a  stable  and 
safe  manner.  To  facilitate  the  passivity  objective  in  (5),  an  auxiliary  control  objective  is  utilized. 
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Specifically,  the  coordinated  master  and  slave  manipulators  are  forced  to  track  a  desired  bounded 
trajectory,  denoted  by  qd(t)  £  Mn,  in  the  sense  that  [13] 

qi(t)  +  q2(t)  ->  qd(t).  (6) 

An  additional  objective  is  that  all  signals  are  required  to  remain  bounded  within  the  closed  loop 
system. 

To  facilitate  the  subsequent  development,  a  globally  invertible  transformation  is  defined  that 
encodes  both  the  coordination  and  passivity  objectives  as  follows 

x  =  Sq  (7) 


where  x(t)  =  [xj  (t)  x2(t)]T  £  R2n,  q(t)  =  [qf(t ) 


q2(t)]r  G  M2n,  and  S  £  M2nx2n  is  defined  as  follows 


S  = 


I  -I 
I  I 


s -1 


1  /  / 
2  -/  / 


(8) 


where  I  £  Mnxn  denotes  the  identity  matrix.  Based  on  (7),  the  dynamic  models  given  in  (1)  and 
(2)  can  be  expressed  as  follows 


where 


M ( x)x  +  C (x,  x)x  + 


M{x)  = 

C(x,x)  = 

B  = 
T(t)  = 

m  = 


S 

s 

s 

s 


—T 


-T 


-T 


7  Mi 
O2  n 

lCx 

®2n 

jB1 


[  C*2  n 

~T  [  7 T? 

m  -  _ 
m) 


Bx  =  T(t )  +  F(t) 


O2 n  ry — 1  _  jn)2nx2n 

m2\s  gM 

O2 n  1  ^  jg>2nx2n 

C2 

O2 n  1  g;  j^2nx2n 

B2 

T 


Tl  ]  e 


t>2n 


s 


—T 


7F1 

f2 


t>2  n 


(9) 

(10) 

(11) 

(12) 

(13) 

(14) 


and  02n  £  Mnxn  denotes  an  n  x  n  matrix  of  zeros.  The  subsequent  development  is  based  on  the 
property  that  M(x).  as  defined  in  (10),  is  a  positive  definite  and  symmetric  matrix  in  the  sense 
that  [15] 

fhi  ||e||2  <iTM(x)i<m2  ||e||2  (15) 

£  M2n  where  rrq,  fh2  £  M  are  positive  constants.  It  is  also  noted  that  M(x)  is  second  order 
differentiable  by  assumption. 

To  facilitate  the  subsequent  development  and  analysis,  the  control  objectives  can  be  combined 
through  a  filtered  tracking  error  signal,  denoted  by  r(t)  £  R2n,  that  is  defined  as  follows 

r  =  e2  +  aie2  (16) 

where  e2{t)  £  M2n  is  defined  as  follows 

e2  —  Ci  +  Oi2e\  (17) 
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where  aq,  a2  G  M.  are  positive  control  gains,  and  e\  (t)  G  M2n  is  defined  as  follows 

ei  =  xd  -  x  (18) 

where  Xd(t)  G  M2n  is  defined  as  follows 

®d=[°n  Qd(t)  ]T  (19) 

where  0n  G  denotes  annxl  vector  of  zeros.  Based  on  the  definition  of  x{t)  in  (7)  and  ei(f)  in 
(18),  it  is  clear  that  if  ||ei(i)||  — >  0  as  t  — >  oo  then  q2{t)  — >•  qi(t)  and  that  qi(t)  +  q2(t )  — >  qd(t)  as 
t  —*  oo. 

The  desired  trajectory  qd(t)  introduced  in  (6)  and  (19)  is  generated  by  the  following  expression 

Mt  qd  +  Brqd  +  Krqd  =  F2.  (20) 

In  (20),  Mr,  Bt ,  Kt  G  Mnxn  represent  constant  positive  definite,  diagonal  matrices,  and  F2(t)  was 
introduced  in  (14).  Based  on  the  assumption  that  F2{t)  G  /M,  standard  linear  analysis  techniques 
can  be  used  to  prove  that  qait),  <jd(t),  qd(t)  £  -Coo-  The  time  derivative  of  (20)  is  given  by  the 
following  expression 


Mt  Q  d  +  Brqd  +  FT(jd  —F 2  .  (21) 

From  (21),  the  fact  that  <jd(t),  qd(t)  G  Coo,  and  the  assumption  that  F2  (t)  G  Coo,  it-  is  clear  that 

Q  d(t)  £  Coq.  By  taking  the  time  derivative  of  (21),  and  utilizing  the  assumption  that  F2  (t)  G  C^, 
we  can  also  show  that  Q  d(t)  G  C^. 

3.2  Closed-Loop  Error  System 

Based  on  the  assumption  that  the  user  and  environmental  forces  are  measurable,  the  control  input 
T(t)  of  (13)  is  designed  as  follows 


T  =  u-F  (22) 

where  u(t)  G  M2n  is  an  auxiliary  control  input.  Substituting  (22)  into  (9)  yields  the  following 
simplified  system 

Mx  +  Cx  +  Bx  =  u.  (23) 

After  taking  the  time  derivative  of  (16)  and  premultiplying  by  M(x ),  the  following  expression  can 
be  obtained 

Mr  =  M  xd  +  Mx  [Cx  +  Bx]  —  u  +a2Me i  +  a\ Me2  (24) 

LLL 

where  (16)- (18),  and  the  time  derivative  of  (23)  were  utilized.  To  facilitate  the  subsequent  analysis, 
the  expression  in  (24)  is  rewritten  as  follows 

Mr  =  TV  +  Nd  —  e2—  u  —  M  r  (25) 

2 
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(26) 


where  the  auxiliary  signal  N(x,  x ,  x,  t )  G 


o2  n 


is  dehned  as 


N  =  N  -Nh 


where  N(x,  x,  x,  t )  G 


t>2  n 


is  dehned  as 


N  =  M  xd  +  M  x  +  a2Me i  +  anMe2  +  e2  +  -7-  ICx  +  Sil  +  -  M  r 

at  1  J  2 


and  Ah(t)  G 


t>2?i 


is  dehned  as 

JVd  =  JVL 


x=xd,  x=xd 


(27) 

(28) 


d 


=  M(xd)  xd  +  M  (xd,xd)xd  +  —  [C(xd,xd )xd  +  Bxd]  . 


Remark  1  To  facilitate  the  subsequent  analysis,  the  following  upper  bound  can  be  developed  for 
N(-) 

N  <  p(||z||)  H^ll  where  z  =  [  ef  e%  rT  ]T 

and  the  positive  function  p(||^||)  is  non- decreasing  in  ||z||  (see  Appendix  F  for  further  details). 
Based  on  (25),  the  auxiliary  control  input  u(t)  introduced  in  (22)  is  designed  as  follows 


u  =  (ks  +  1) 


e2(t)  ~  e2(t0)  +  «i  /  e2(r)dr 


't0 


+  (^1+^2)  /  sgn(e2(r))dT 


(29) 


'to 


where  ks,  /31,/32  G  M  are  positive  control  gains,  and  sgn(-)  denotes  the  vector  signum  function. 
The  term  e2(t0)  in  (29)  is  included  so  that  u(t 0)  =  0.  The  time  derivative  of  (29)  is  given  by  the 
following  expression 

u=  (ks  +  l)r  +  (P1+  fd2)  sgn(e2).  (30) 

Substituting  (30)  into  (25)  yields  the  following  closed-loop  error  system 

Mr  =  -(kg  +  l)r  -  (^  +  (32)  sgn(e 2)  +  N  +  Nd  -  e2  -  M  r.  (31) 

Remark  2  Based  on  the  expressions  in  (19),  (28)  and  the  fact  that  qd(t),  qd(t),  qd(t),  Qd(t),  and 


Q  d(t)  G  Too,  then  ||JVd(£)||  and  Nd(t) 
as  follows 


can  be  upper  bounded  by  known  positive  constants  Si,  g2  E 


IW)II  <  5. 


A rd(t) 


<  ?2- 


(32) 


3.3  Stability  Analysis 

Theorem  1  The  controller  given  in  (22)  and  (29),  ensures  that  all  closed-loop  signals  are  bounded 
and  that  coordination  between  the  master  and  slave  manipulators  is  achieved  in  the  sense  that 

q2(t)  — >  qi(t)  as  t  — >  00  (33) 

provided  the  control  gain  /31  introduced  in  (29)  is  selected  to  satisfy  the  following  sufficient  condition 

Pi  >  £1 4  ?2  (34) 

a\ 

where  and  g2  are  given  in  (32),  the  control  gains  an  and  a2  are  selected  greater  than  2,  and  ks  is 
selected  sufficiently  large  with  respect  to  the  initial  conditions  of  the  system. 
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Proof.  See  Appendix  A. 

Theorem  2  The  controller  given  in  (22)  and  (29)  ensures  that  the  teleoperator  system  is  passive 
with  respect  to  the  scaled  user  and  environmental  power. 

Proof.  See  Appendix  B. 


3.4  Simulation  Results 


A  numerical  simulation  was  performed  to  demonstrate  the  performance  of  the  controller  given  in 
(22)  and  (29).  The  following  2-link,  revolute  robot  dynamic  model  was  utilized  for  both  the  master 
and  slave  manipulators  [21] 
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(35) 


where  s(-)  and  c(-)  denote  the  sin(- )  and  cos(-)  functions.  For  the  master  manipulator,  i  —  1  and 
PU  =  3.34  [kg-m2],  p2l  =  0.97  [kg-m2],  p3l  =  1.0392  [kg-m2],  p4l  =  0.6  [kg-m2],  fdll  =  1.3  [Nm-sec], 
and  fd2l  =  0.88  [Nm-sec].  For  the  slave  manipulator,  i  =  2  and  pi2  =  2.67  [kg-m2],  p22  =  1.455 
[kg-m2],  p32  =  0.929  [kg-m2],  p4a  =  0.537  [kg-m2],  fdl2  =  1.3  [Nm-sec],  and  fd22  =  0.88  [Nm-sec], 
where  the  parameters  are  based  on  [21].  For  this  simulation,  the  positive  adjustable  power  scaling 
term  was  selected  as  7  =  1.  The  user  input  force  vector  was  set  equal  to  the  following  arbitrary 
periodic  time- varying  signals 


'  Fii  ' 

25  sin  (1.  If) 

_Fl2 

35  sin(t) 

(36) 


To  emulate  contact  with  the  environment,  a  spring-like  input  force  vector  was  selected  as  follows 


'  f2i  - 

-0.6gi2  -  ql2 

.F22  _ 

_  — 0.6g22  -  Q22  _ 

(37) 


To  assist  in  meeting  the  passivity  control  objective,  the  coordinated  teleoperated  system  must  follow 
a  desired  trajectory  which  was  generated  by  the  system  described  by  (20)  and  for  this  simulation 
was  selected  as  follows 
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(38) 


where  qdi(t)  and  qd2(t)  denote  the  desired  link  positions,  and  F2(t)  is  equal  to  the  following  expression 

F2(t)  =  \('fFl(t)  +  F2(t)) 


where  F2(t)  was  defined  in  (14). 
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The  actual  trajectory  for  the  master  and  slave  manipulators  are  demonstrated  in  Figure  1  for 
controller  gains  selected  as  ks  =  100  and  /3,  |-  S2  =  25.  The  link  position  tracking  error  between 
the  master  and  slave  manipulators  can  be  seen  in  Figure  2.  From  Figures  1  and  2,  it  is  clear  that 
the  coordination  control  objective  is  achieved.  The  actual  trajectory  for  the  coordinated  system 
{qi(t)  +  <?2 (t))  and  the  desired  trajectory  as  defined  by  (38),  are  demonstrated  in  Figure  3.  The 
coordinated  system  versus  the  desired  trajectory  tracking  error  as  defined  by  qi(t)  +  q2(t )  —  qd(t),  is 
given  in  Figure  4.  From  Figures  3  and  4,  it  is  clear  that  the  coordinated  system  tracks  the  desired 
trajectory.  The  control  torque  inputs  for  the  master  and  slave  manipulator  are  provided  in  Figures 
5  and  6,  respectively. 


Link  1 


Figure  1:  Actual  trajectory  for  master  (i.e. ,  qi(t))  ( — )  and  slave  (i.e.,  q2(t ))  (-  -)  manipulators  for 
Link  1  and  Link  2. 


4  UMIF  Control  Development 

For  the  UMIF  controller  development,  the  subsequent  analysis  will  prove  a  global  asymptotic  result 
despite  unmeasurable  user  and  environmental  input  forces  (UMIF)  provided  the  dynamic  models  of 
the  respective  manipulators  are  known.  This  development  also  requires  the  assumption  that  Frit). 
Fi(t),  Fi(t )  G  Loo  Vi  =  1,2. 

4.1  Objective  and  Model  Transformation 

One  of  the  two  primary  objectives  for  the  bilateral  teleoperator  system  is  to  ensure  coordination 
between  the  master  and  the  slave  manipulators  as  in  (4).  The  other  objective  is  to  ensure  that 
the  system  remains  passive  with  respect  to  the  scaled  user  and  environmental  power  as  in  (5).  To 
assist  in  meeting  the  passivity  objective  the  following  desired  trajectory,  defined  as  xd[t)  G  M2n,  is 
generated  by  the  following  dynamic  system 

Mxd  +  BTxd  +  KTxd  +  ^  M  xd  =  F. 
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(39) 


Link  1 


Figure  2:  Link  position  tracking  error  between  the  master  and  slave  manipulators  (i.e.,  qi(t)  —  q2(t))- 


Link  1 


Figure  3:  Actual  coordinated  (i.e.,  qi(t)  +  g2(^))  trajectory  ( — )  and  desired  (i.e.,  quit))  trajectory 
(-  -)  for  Link  1  and  Link  2. 
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Link  1 


Figure  4:  The  coordinated  system  versus  the  desired  trajectory  tracking  error  (i.e.,  qi(t)  +  (t)  — 

Qd(t))- 


Master  Link  1 


Figure  5:  Master  manipulator  control  input  torque  (i.e.,  T\ (t)). 
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Slave  Link  1 


Figure  6:  Slave  manipulator  control  input  torque  (i.e. ,  T->(t)). 


In  (39),  M  (. x )  was  defined  in  (10),  Bt  and  Kt  G  R2nx2n  represent  constant  positive  definite, 
diagonal  matrices,  and  F{t)  G  R2n  is  a  subsequently  designed  nonlinear  force  observer,  and  xd{t)  G 
M2n  can  be  decomposed  as  follows 

Xd=[xdi(t)  x&(t)]T  (40) 

where  xdi(t),  xd2(t)  G  Mn.  Subsequent  development  will  prove  that  F(t)  G  Based  on  this  fact, 
the  development  in  Appendix  C  can  be  used  to  prove  that  Xd(t),  xd(t)  G  then  (39)  can  be  used 
to  prove  that  Xd(t)  G  £qc  as  shown  later,  the  passivity  objective  is  facilitated  by  ensuring  that  the 
coordinated  master  and  slave  manipulators  are  forced  to  track  a  desired  bounded  trajectory  x&(t ) 
in  the  sense  that 


Qi(t)  +  q2(t)  ->  xd2{t)  (41) 

where  was  dehned  in  (40).  An  additional  objective  is  that  all  signals  are  required  to  remain 

bounded  within  the  closed  loop  system. 

To  facilitate  the  subsequent  development,  a  globally  invertible  transformation  is  defined  that 
encodes  both  the  coordination  and  passivity  objectives  as  follows 


x  =  Sq  + 


Xdl 

0„ 


(42) 


where  x(t)  =[xf(t)  (t)]T  G  M2n,  q(t)  =[gf(t)  gJ(t)]T  G  M2n,  xdi (t)  G  Mn  was  defined  in  (40),  the 

zero  vector  0n  G  Mn  and  S  G  M2nx2n  was  dehned  in  (8).  Based  on  (42),  the  dynamic  models  given 
in  (1)  and  (2)  can  be  expressed  as  follows 


M{x)x  —  M(x ) 


Xdl 

0. 


+  C(x,  x)x  —  C(x ,  x) 


Xdl 

On 


+  Bx  —  B 


Xdl 

On 


=  T(t)  +  F{t )  (43) 


where  M(x),  C(x,x),  B ,  T(t),  and  F(t)  were  dehned  in  (10)-(14). 
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To  facilitate  the  subsequent  UMIF  development  and  analysis,  the  control  objectives  can  be 
combined  through  a  filtered  tracking  error  signal  denoted  by  r(t )  G  M2n,  that  is  defined  as  follows 

r  =  e2  +  e2  (44) 


where  e2(t)  G  M2n  is  now  defined  as  follows 

e2  =  M  (ei  +  a2ei)  (4:5) 

where  a2  G  K  is  a  positive  control  gain,  and  e\  (t)  G  M2n  was  defined  in  (18)  as  follows 

ei  =  xd  -  x 


where  xd(t)  was  defined  in  (40). 


4.2  Closed  Loop  Error  System 

To  facilitate  the  development  of  the  closed- loop  error  system  for  r(t),  we  first  examine  the  error 
system  dynamics  for  e\ (t)  and  e2{t).  To  this  end,  we  take  the  second  time  derivative  of  e\ (t)  and 
premultiply  by  M (. x )  to  obtain  the  following  expression 


Me! 


F  -  BTxd  -  KTxd  -  -M  xd-T  -  F 


-M 


xd\ 
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+  Cx-C 


Xdl 

0n 


+  Bx  —  B 


xd\ 

0„ 


(46) 


where  (43)  and  (39)  were  utilized.  Based  on  the  assumption  of  exact  model  knowledge,  the  control 
input  T(t)  is  designed  as  follows 


f  =  Ti  -  BTxd  -  KTxd  -  ^  M  xd  (47) 


M 

Xdl 

+  Cx-C 

Xdl 

+  Bx  —  B 

Xdl 

_  0n 

_  On 

_  0n 

where  Ti(t)  G  M2n  is  an  auxiliary  control  input.  Substituting  (47)  into  (46)  yields  the  following 
simplified  expression 


Me'i  —  F  —  F  —  T\.  (48) 

Based  on  (48),  the  time  derivative  of  e2(f)  in  (45)  can  be  obtained  as  follows 

e2  =M  ei  +  ct2  M  e\  +  a2Me i  +  F  —  F  —  Tj.  (49) 

Based  on  the  expression  in  (49),  the  auxiliary  control  input  7j  (t)  is  designed  as  follows 

Xi  =M  e\  +  cx2  M  e\  +  a2Me (50) 
After  substituting  (50)  into  (49),  the  following  can  be  written 

e2  =  F-F.  (51) 
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Taking  the  time  derivative  of  (51)  yields  the  resulting  expression 

e2  —F  —  F  .  (52) 

The  following  error  system  dynamics  can  now  be  obtained  for  r(t)  by  taking  the  time  derivative  of 
(44) 

r  =  r  —  e2+  F  —  F  (53) 

where  (44)  and  (52)  were  both  utilized.  Based  on  (53)  and  the  subsequent  stability  analysis,  the 
proportional-integral  like  nonlinear  force  observer  F(t)  introduced  in  (39)  is  designed  as  follows 

F  =  -(ks  +  1)  e2(t)  —  e2(t0)  +  f  e2(r)dT  -(P1  +  P2)f  sgn(e2(r))dT  (54) 

j  to  J  Jto 

where  ks,P1,  and  /32  G  M.  are  positive  control  gains,  and  sgn(-)  denotes  the  vector  signum  function. 
The  expression  given  in  (54)  is  designed  such  that  F(t0)  =  0.  The  time  derivative  of  (54)  is  given 
by  the  following  expression 

F=  ~(ks  +  l)r  —  (P1  +  P2)  sgn  (e2) .  (55) 

Substituting  (55)  into  (53)  yields  the  following  closed  loop  error  system 

r  =  -e2-  F  -ksr  -  (f31  +  p2)  sgn  (e2)  •  (56) 

Remark  3  Based  on  (14)  and  the  assumption  that  Fi(t),  Fi(t),  Fi(t )  G  L ^  Vi  =  1,2,  upper  bounds 
can  be  developed  for  F  (t)  and  F  (t)  as  follows 

|>(*)|<?3  pW||<Q  (57) 

where  ^3,  qGK  denote  positive  constants. 

4.3  Stability  Analysis 

Theorem  3  The  controller  given  in  (47)  and  (50)  ensures  that  all  closed-loop  signals  are  bounded 
and  that  coordination  between  the  master  and  slave  manipulators  is  achieved  in  the  sense  that. 

q2(t)  — >  qi(t)  as  t  — >  00  (58) 

provided  the  control  gain  /31,  introduced  in  (54)  is  selected  to  satisfy  the  sufficient  condition 

P\>  5 3  +  <>4,  (59) 

where  ^3  and  q  were  introduced  in  (57). 

Proof.  See  Appendix  D. 

Theorem  4  The  controller  given  in  (47)  and  (50),  ensures  that  the  teleoperator  system  is  passive 
with  respect  to  the  scaled  user  and  environmental  power. 

Proof.  See  Appendix  E. 
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4.4  Simulation  Results 


A  numerical  simulation  was  performed  for  the  controller  given  in  (47)  and  (50).  The  2- link,  revolute 
robot  dynamic  model  utilized  in  (35)  was  utilized  for  both  the  master  and  slave  manipulators.  The 
user  input  force  vector  in  (36)  and  the  environmental  input  force  vector  in  (37)  were  also  utilized. 

To  meet  the  passivity-based  control  objective,  the  coordinated  teleoperated  system  must  follow  a 
desired  trajectory,  which  is  generated  from  (39)  using  the  same  parameter  values  for  the  transformed 
inertia  matrix.  The  values  for  Bt ,  AY  G  M4x4  were  set  to  the  following  values 

Bt  =  diag{ 5,  5,  5, 5} 

Kt  =  diag{  25,25,25,25} 

where  Bt  and  AY  are  both  diagonal  matrices. 

The  actual  trajectory  for  the  master  and  slave  manipulators  are  demonstrated  in  Figure  7  where 
the  control  gains  were  selected  as  ks  =  100,  f31  I  b2  =  100,  and  a2  =  200.  The  link  position 
tracking  error  between  the  master  and  slave  manipulators  can  be  seen  in  Figure  8.  From  Figures  7 
and  8,  it  is  clear  that  the  coordination  control  objective  is  achieved.  The  actual  trajectory  for  the 
coordinated  system  ( qi(t )  +  g2(^))  and  the  desired  trajectory  as  defined  in  (39),  are  demonstrated 
in  Figure  9.  The  coordinated  system  versus  the  desired  trajectory  tracking  error  as  defined  by 
qi(t )  +  g2(f)  —  Xd2(t),  is  given  in  Figure  10.  From  Figures  9  and  10,  it  is  clear  that  the  coordinated 
system  tracks  the  desired  trajectory.  The  output  of  the  nonlinear  force  observer  is  provided  in 
Figure  11.  The  control  torque  inputs  for  both  the  master  and  slave  manipulators  are  provided  in 
Figures  12  and  13,  respectively. 


Master  Link  1  and  Slave  Link  1 


Figure  7:  Actual  trajectory  for  master  (i.e. ,  qi(t))  ( — )  and  slave  (i.e.,  g2(t))  (-  -)  manipulators  for 
Link  1  and  Link  2. 


5  Conclusions 

Through  the  use  of  transformations,  dynamic  trajectory  generations,  and  continuous  nonlinear  in¬ 
tegral  feedback  terms,  two  controllers  were  proven  through  Lyapunov-based  techniques  to  passively 
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Link  1 


Link  2 


Figure  8:  Link  position  tracking  error  between  the  master  and  slave  manipulators  (i.e.,  q\ (t)  —  r/2(t)). 


Master  Link  1  +  Slave  Link  1  and  x.. 

dl 


Figure  9:  Actual  coordinated  (i.e.,  qi(t)  +  q2(t))  trajectory  ( — )  and  desired  (i.e.,  quit))  trajectory 
(-  -)  for  Link  1  and  Link  2. 
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Link  1 


Link  2 


Figure  10:  The  coordinated  system  versus  the  desired  trajectory  tracking  error  (i.e. ,  qi(t)  +  f/2(t)  — 
Xd2(t)). 


Time  [sec] 


Figure  11:  The  output  of  the  nonlinear  force  observer  (i.e.  F(t))  . 
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Master  Link  1 


Figure  12:  Master  manipulator  control  input  torque  (i.e. ,  T\(t)). 


Slave  Link  1 


Figure  13:  Slave  manipulator  control  input  torque  (i.e.,  r2(t)). 
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coordinate  the  master  and  slave  manipulators  with  respect  to  the  scaled  user  and  environmental 
power  despite  incomplete  system  knowledge.  Implementing  either  controller  would  provide  the  user 
of  the  closed  loop  teleoperator  system  with  a  power  scalable,  coordinated  master-slave  tool  that 
provides  safe  and  stable  user  feedback.  The  MIF  controller  was  developed  despite  uncertainty  in 
the  dynamics  of  the  teleoperator  system  resulting  in  a  semi-global  asymptotic  result,  and  the  UMIF 
controller  was  developed  despite  unmeasurable  user  and  environmental  force  inputs  resulting  in  a 
global  asymptotic  result.  Simulation  results  demonstrate  for  both  controllers  that  the  coordination 
and  tracking  control  objectives  are  met. 
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A  Proof  of  Theorem  1 

Lemma  1  Let  the  auxiliary  functions  Lfit),  L2(t)  G  M  be  defined  as  follows 

Li  =  rT  (Nd  -  fi1sgn(e2))  (60) 

L2  =  -p2elsgn(e2) 

where  P1  and  P2  were  introduced  in  (29).  Provided  p1  is  selected  according  to  the  following  sufficient 
condition 

Pi  >  <>i  H1 - (61) 

a  i 

where  and  g2  are  given  in  (32),  and  an  is  introduced  in  (16),  then 

It0  Li(r)dr  <  £bl  Jt[  L2(r)dr  <  £b2  (62) 

where  the  positive  constants  £w,£62  e  are  defined  as 

2  n 

£bi  -  e2(t0)Nd(t0)  (63) 

i=  1 
2  n 

(,b2  -  ^2^|e2i(to)|  • 


Proof.  After  substituting  (16)  into  (60)  and  then  integrating,  the  following  expression  can  be 
obtained 


•to 


Li(r)dr  =  an  /  e2  (r)  [7V«j(r)  -  Pisgn{e2{r))]  dr 
dt0 

ft  A„T( 


(64) 


+ 


'to 


de2  (t) 
dr 


rt  del  (T) 

dr 


Nd(r)dT  -  f31 


'to 


sgn{e2{r))dT . 


After  evaluating  the  second  integral  on  the  right  side  of  (64)  by  parts  and  evaluating  the  third 
integral,  the  following  expression  is  obtained 


Lidr  =  Oil  I  e2  \ 


'to 


'to 


1  dNd 
a  i  dr 


Pi  sgn(e2)  dr 


2  n 


+e2  ( t)Nd(t )  -  Pi  ^2  le2 i(t)  I  +  £&i- 


(65) 


i=  1 


The  expression  in  (65)  can  be  upper  bounded  as  follows 

ft  ft 


Lidr  ^  a  i 


'to 


Y^hi(r) |  (\ Ndi(r)\  +  — 

't0  ^  V  «i 

2  n 


dNd,(r) 


dr 


Pi  ]  dr 


(66) 


1=1 
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If  0!  is  chosen  according  to  (34),  then  the  first  inequality  in  (62)  can  be  proven  from  (66).  The 
second  inequality  in  (62)  can  be  obtained  by  integrating  the  expression  for  L2(t)  introduced  in  (60) 
as  follows 


't0 


L2(r)da  =  -fi2  /  e2(T)sgn(e2(T))d,T 
Jt0 


2  n 


ib2  @2  le2«(^)l  —  ib2- 


i=  1 


(67) 


The  following  is  the  proof  of  Theorem  1. 

Proof.  Let  the  auxiliary  functions  -Pi(t),  P>(t)  G  M  be  defined  as  follows 

Pi(t)  =  ^b i-  ['  Li(r)dr  >  0  (68) 

Jt0 

P2(t)  =  db2~  [  L2(r)dr  >  0  (69) 

Jto 


where  £bl,  Li(t),  £ b2 ,  and  L2(t )  were  defined  in  (60)  and  (63).  The  results  from  Lemma  1  can  be  used 
to  show  that  P\ (t)  and  P2(t)  are  non- negative.  Let  V(y,t )  G  ffi.  denote  the  following  nonnegative 
function 


V  =  ^efei  +  ^e2e2  +  KTMr  +  Pi  +  P2 

(70) 

where  y(t)  G  M6n+2 

y(t)  =  [  zT  \[P\  \[^2  ]T 

(71) 

where  the  composite  vector 

z(-)  G  M6n  is  defined  as  follows 

A  r  T  T  T  1 T 

z=lei  4  r1  \  . 

(72) 

Note  that  (70)  is  bounded  by 

Wi(y)  <  V(y,t)  <  W2(y) 

(73) 

where 

W-'ife)  =  A,  ||»(i)l|2  ir2(!/)  =  A2||y(«)||2 

(74) 

where  Ai  =  \  min  {1,  mi}  and  \2  =  max  {l,  |m2}  where  rrii  and  m2  were  introduced  in  (15). 

After  taking  the  time  derivative  of  (70)  the  following  expression  can  be  obtained 

V  =  -a2efe!  -  aie2e2  -  rT  (ks  +  1)  r  (75) 

+efe2  +  rTN  -  rT f32sgn(e2 )  +  fi2e2  sgn{e2) 

where  (16),  (17),  (31),  (68),  and  (69)  were  utilized.  To  facilitate  the  subsequent  analysis,  the 
following  inequality  can  be  developed  from  (26)  -  (28)  (see  Appendix  F  for  further  details) 

^<P(MI)NI  (76) 
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where  p  (•)  is  a  positive,  non-decreasing  function.  By  utilizing  (16),  (76),  and  the  triangle  inequality, 
V  ( t )  can  be  upper  bounded  as  follows 

V  <  —  a2ef  e\  —  aqe;fe2  —  rT  (ks  +  1)  r  (77) 

+efei  +  e2e2  +  p(||z||)  |M|  INI  —  cti e2 /32spn(e2). 

By  utilizing  (72),  V(t)  of  (77)  can  be  upper  bounded  as  follows 

2  n 

V  <  —  A3  ||z||2  -  ks  ||r||2  +  p(p||)  ||r||  ||z||  -  aq^2  ^  |e2i|  (78) 

i= 1 


where  A3=  min{ai  —  1,  ct2  —  1, 1}.  After  completing  the  squares  for  the  second  and  third  term  on 
the  right  side  of  (78),  the  following  expression  can  be  obtained 


V  < 


2  n 

z||2  -  Oi^2^  | e2i 
i=  1 


(79) 


Provided  a  \  and  cx2  are  selected  to  be  greater  than  2  and  ks  is  selected  according  to  the  following 
sufficient  condition 


k  >AMor 

k‘-  4A,  01 


k||  <  P  1  ( 2\fks\^j 


then  the  following  inequality  can  be  developed 


2  n 


V<W(y)-aip2J2 


e2  i 


i= 1 


where  W(y)  e  M  denotes  the  following  nonpositive  function 

W(y)  4  -/?„  ||z||2 


(80) 


(81) 


(82) 


where  /30  G  M  denotes  a  positive  constant.  From  (70)-(74)  and  (79)-(82)  the  regions  D  and  S  can 
be  defined  as  follows 

V  ±  [y  e  M6n+2  |  |b||  <  /T1  (2  ^/kX)}  (83) 


5  = 


e  V  |  W2(y)  <  Xi  (p-1 


(84) 


The  region  of  attraction  in  (84)  can  be  made  arbitrarily  large  to  include  any  initial  conditions 
by  increasing  the  control  gain  ks  (i.e.  a  semi-global  stability  result).  Specifically,  (74)  and  the  region 
defined  in  (84)  can  be  used  to  calculate  the  region  of  attraction  as  follows 

W2(y(t0))  <  A1(P-1(2V/^))2  (85) 

1  (2  v&) , 


l|y(*°)ll  <  \[yp 
v  a2 
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which  can  be  rearranged  as 


By  using  (72),  (63),  and  (71)  an  explicit  expression  for  ||y(£0)||  can  be  written  as 


ll?/(^o)||2  —  ||ei(to)  ||2  +  ||e2(h))||2 

+  lk(^0)||2  +  Cbl  +  Cb2- 


(86) 


(87) 


From  (70),  (81),  and  (84)-(86),  it  is  clear  that  V(y,t )  G  Coo  Vy(io)  G  <S;  hence  e\ (t),  e2 (t),  r(t), 
z(t),  y(t )  G  Coo  Vy(t o)  G  S.  From  (81)  it  is  easy  to  show  that  e2(t)  G  C\  Vy(t0)  G  S.  The  fact  that 
e2(t)  G  C i  Vy(t0)  G  5  can  be  used  along  with  (17)  to  determine  that  ei(t),ei(t)  G  C\  Vy(t0)  G  S. 
From  (7),  (18)  and  the  assumption  that  qd(t )  G  Coo,  it  is  clear  that  x(t),  q(t )  G  Coo  V7/(t o)  G  5. 
From  (16)  and  (17)  it  is  also  clear  that  e2 (£),  ei(i)  G  Too  Vy(io)  G  5.  Using  these  boundedness 
statements,  it  is  clear  that  both  u  (t)  G  Coo  Vy(io)  G  5.  From  the  time  derivative  of  (17),  and  using 
the  assumption  that  qd(t)  G  Too  along  with  (23),  it  is  clear  that  u(t)  G  Too  Vy(i o)  G  5.  The  previous 
boundedness  statements  can  be  used  along  with  (31),  (76),  and  Remark  2  to  prove  that  fit)  G  Too 
\/y(to)  G  5.  These  bounding  statements  can  be  used  along  with  the  time  derivative  of  (82)  to  prove 
that  W(y(t))  G  Too  Vy(io)  G  S';  hence,  W(y(£))  is  uniformly  continuous.  Standard  signal  chasing 
arguments  can  be  used  to  prove  all  remaining  signals  are  bounded.  A  direct  application  of  Theorem 
8.4  in  [10]  can  now  be  used  to  prove  that  ||z(t)||  — >  0  as  t  — >  oo  Vy(i0)  G  S.  From  (72),  it  is  also  clear 
that  ||r(t)||  — >•  0  as  t  — >  oo  Vy(i0)  G  S.  Based  on  the  dehnitions  give  in  (16)  -  (18),  standard  linear 
analysis  tools  can  be  used  to  prove  that  if  ||r(£)||  — >  0  then  ||e2(t)||,  ||e2(t) ||  ,  ||e1(i)||,  ||e1(t)||^  0 
as  t  — >  oo  \/y(to)  G  S.  Based  on  the  dehnition  of  x(t)  in  (7)  and  e\ (t)  in  (18),  it  is  clear  that  if 
||ei(t) || — 0  then  ||gi  (t)  -  q2  (t)||  0  and  qx  (t)  +  q2  (t )  ->  qd(t) .  ■ 

B  Proof  of  Theorem  2 

Proof.  Let  Vp(t)  G  M  denote  the  following  nonnegative,  bounded  function 

Vp  -  \ <ldMTqd  +  ^qdKTqd-  (88) 

After  taking  the  time  derivative  of  (88),  the  following  simplified  expression  can  be  obtained 

VP  =  qTdF2-  qTdBTqd  (89) 

where  (20)  was  utilized.  Based  on  the  fact  that  Bt  is  a  constant  positive  definite,  diagonal  matrix, 
the  following  inequality  can  be  developed 


Vp  <  qdF2. 

After  integrating  of  both  sides  of  (90),  the  following  inequality  can  be  developed 


~c2  <  Vp(t)  -  Vp(t0 )  <  /  qd  (cr) F2(cr) do- 


'to 


(90) 


(91) 
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where  C2  G  1  is  a  positive  constant  (since  Vp(t)  is  bounded  from  the  trajectory  generation  system 
in  (20)). 

By  using  the  transformation  in  (7),  the  left  side  of  (5)  can  be  expressed  as 


7*i(r) 

fi(r) 


dr 


xTFdr. 


'to 


(92) 


By  substituting  the  time  derivative  of  (18)  into  (92),  the  following  expression  can  be  obtained 


iT(r)F(r)dr  =  /  gJ(r)F2(r)dr  -  /  ef(r)F(r)dr 


'to 


'to 


'to 


(93) 


where  (19)  was  utilized.  Based  on  (91),  it  is  clear  that  f*  gJ(r)F2(r)dr  is  lower  bounded  by  — c2, 
where  c2  was  defined  as  a  positive  constant.  The  fact  that  et  (t)  G  £|  from  the  proof  for  Theorem  1 
and  the  assumption  that  F{t)  G  can  be  used  to  show  that  the  second  integral  of  (93)  is  bounded. 
Hence,  these  facts  can  be  applied  to  (92)  and  (93)  to  prove  that 


[ 1  -T(  \ 

iF\{t) 

/  Q  (t) 

> t0 

F2(t )  _ 

dr  >  — C3 


where  c3G  M  is  a  positive  constant.  ■ 


(94) 


C  UMIF  Desired  Trajectory  Stability  Analysis 
Proof.  Let  I  j  (t)  G  M  denote  the  following  nonnegative  function 

lb  =  ^  e2  +  irTr  +  Pi  +  P2.  (95) 

Based  on  (95)  and  the  closed  loop  error  systems  in  (56),  the  proof  of  Theorem  3  can  be  followed 

directly  to  prove  that  ei  (t),  e2(f),  r(f),  F(t),  F  (t)  G  £00  as  well  as  that  ei(f),  e2(f),  and  r{t )  — >  0  as 
t  — >•  00  regardless  of  whether  or  not  Xd  ( t ) ,  Xd  ( t ) ,  Xd  ( t )  G  £oo-  Therefore  the  fact  that  F(t)  G  £00 
can  be  used  in  the  subsequent  analysis.  As  a  means  to  prove  that  Xd(t),  Xd(t),  Xd(t )  G  let 
V2  (t)  Gi  denote  the  following  nonnegative  function 


P2  =  H3  +  L 


where  V3  (t)G  M  denotes  the  following  nonnegative  function 

Vi  =  -x\Mxi  +  -x^Ktx  d 


(96) 


(97) 


where  Xd(t),Xd(t)  were  defined  in  (40),  where  KT  was  defined  in  (39),  and  M  ( x )  was  defined  in  (10). 
The  expression  given  in  (97)  can  be  lower  bounded  by  the  auxiliary  function,  L(x )  G  M,  defined  as 
follows 


L  = 


2  ex^Mxd 
1  +  2x^xd 


<  V3(t) 


(98) 
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where  £  G  1  is  a  positive  bounding  constant  selected  according  to  the  following  inequality 

min  {mi,  Amin{/iT}} 


0  <  £  < 


2  m 


Loo 


(99) 


where  Amin {Kt}e  K.  denotes  the  minimum  eigenvalue  of  Kt,  fh\  was  dehned  in  (15)  and  m-Loo^  K- 
denotes  the  induced  infinity  norm  of  the  bounded  matrix  M(x).  From  (98)  it  is  clear  that  V2  (t)  is 
a  non-negative  function.  Also,  x(t)e  M4n  is  dehned  as 


-  A 
X 


.1 


X 


T  I T 


(100) 


The  expression  in  (96)  satisfies  the  following  inequalities 

Ai  ||x||2  <  V2(x)  <  A2  ||x||2  (101) 

where  A1?  A2  G  M.  are  positive  constants  dehned  as  follows,  provided  £  is  selected  sufficiently  small 

Ai  =  ^min{m1,  Amin{iFT}}  -  £^c  (102) 

A2  —  ^  max  {m2,  Amax{A'T}}  +  eic 

where  fhi  and  m2  were  introduced  in  (15),  and  Amax{  Ar}e  M  denotes  the  maximum  eigenvalue  of 
Kt.  In  (102),  £cG  M  is  a  positive  constant  dehned  as  follows 

,2mLoo<5aj  (103) 

where  6a  G  M  is  some  positive  constant,  and  mLoo  was  introduced  in  (99). 

To  facilitate  the  subsequent  analysis,  the  time  derivative  of  (98)  can  be  determined  as  follows 


L  =  max 


f  2mLoo 

l  &  a 


L  _  2 exdMxd  +  2exTd  M  xd  +  2 exdMxd 
1  +  2xjxd 

_2£  (x^Mxd)  Ax^xd 
(1  +  2x^xd)2 

After  utilizing  (39),  the  expression  in  (104)  can  be  written  as 

^  _  2exdKTxd  2 ex^BTxd  ^  2 exdF 

1  +  2x^xd  1  +  2x^xd  1  +  2x^xd 

exd  M  xd  2 exdMxd  2e  ( xdMxd )  4xdxd 

+ 1  +  2xTdxd  +  1  +  2xTdxd  (1  +  2  xTdxdf 


The  signal  in  (105)  can  be  upper  bounded  as  follows 
L  < 


2 ^  IMt  +  [iMf  +  IMf] 


T 


T 


1  +  2x1dxd 
2e 

1  +  2x^xd 


1  +  2xdxd 


<5 2  \\xd\\2  +  — 

0  2 

11 2  2  £m2 

M  + 


1  +  2xi  xd 


1  +  2xi  xd 


+  £^3 ifh  ll^d||2  + 


xd  2  +  8 em2  xd  2 


(104) 


(105) 


(106) 
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where  the  following  properties  were  utilized 


2  exdKTxd 

1  +  2xTdxd 

2  exdBTxd 
1  +  2xTdxd 

2  exTdF 


1  +  2xd  xd 
ex T  M  xd 


1  +  2xd  xd 
2exd  Mxd 


1  +  2xd  xd 


(1  +  2xTdxd) 


< 


< 


2e  (: xTdMxd )  Ax^xd 
(1  +  2xdxd)2 

IM|2 


1  +  2x^xd 

\\Xdf 


2  — 


2eAmin{/iT} 


1  +  2x1dxd 
2eX  max{-BT} 


Xd 


— 


[INI2  +  ll^ll2] 
1 


^2  ||^d||  + 


T  m  — 


T™  — 


1  +  2x^xd 

_?£_l 

1  +  2xTdxd  [_ 

ll^d||2  +  + 

2  £777.2 


1  +  2x^xd 


g£m£e 
1  +  2x^xd 


ll^dll 


<  86777-2  ||irf|| 


<  1 


<  1. 


(107) 

(108) 

(109) 

(110) 
(111) 

(112) 

(113) 

(114) 


In  (109),  K  denotes  a  positive  bounding  constant.  In  (110),  £3G  M  denotes  a  positive  bounding 
constant  defined  as 


Fall  <  p 

1  +  2xixa  ~  3 


(115) 


and  M  denote  positive  bounding  constants  defined  as 


M 


<£*(IM  +  £i)- 


(116) 


The  inequality  in  (116)  is  obtained  by  using  the  facts  that  the  inertia  matrix  is  second  order 
differentiable  and  that  e\ (i)e  Too,  (see  proof  of  Theorem  3).  In  (111)  and  (112),  1  is  a 

positive  constant  defined  in  (15). 

Based  on  the  development  in  (104)-(114),  the  time  derivative  of  (96)  can  be  upper  bounded  as 
follows 


Vo  < 


-  W Bt }  ||±d||2  -  2f°"a{r^}  IM|2 
+TTf@T  [|W|2  +  IW|21 

+^1  ||i</|l"  +  T~ 
o  1 

+£«  jmi2 + ^  + 


2  26 

_  ,,  i ,  9  1 

2 

F 

&2  \\xd\\2  +  — 

F 

+  1  +  2x^xd 

o  2 

1  +  2x1dxd 


xd 


267779 


1  +  2x1dxd 


||(7d||2  +  867772  \\xd 


(117) 
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where  (39),  (106),  and  the  following  inequalities  were  utilized 


-X^BTXd  <  ~X min{-BT}  \\xd 


xTdF  <  6\  ||id||2  + 


Si 


where  <5iG  M  denotes  a  positive  bounding  constant.  The  expression  in  (117)  can  be  simplified  as 
follows 


Vo  < 


-  \\xd 

~  INI 

+ 


1 2  |  \  jn  i  c  2<sAmax  { Bt }  t 

Amini DT)  ~  0 1 - — T - 


2  enrto 


1  +  2xTdxd 
2eXmm{KT}  2eX max{BT} 


_ 

1  +  2xfxd  1  +  2xTdxd 


8emo 


2e8o 


1  +  2xTdxd 


1  +  2xTdxd 


1  +  2xi  xd 


"  1 

2 

2e 

'  1 

2 

Si 

F 

+ 

.1  +  2xfxd_ 

t2 

F 

"b 

(118) 


Provided  BT.  8i,  82,  e,  and  KT  are  selected  to  satisfy  the  following  sufficient  conditions 


Amin { Bt }  >  8\+  £  (2Amax{-£>T}  +  £3 +  £m£e  +  Wm2) 

Amin  { -77 j1 }  >  A  max  {Bt}  +  82 


the  expression  in  (118)  can  be  upper  bounded  as  follows 


V2  < 


min  {7a,  7f)}  ,  _ 

- t - r3  -t-  e2 

A2 


(119) 


where  (100)  was  utilized,  and  ja,  jb,  e2G  M  denote  positive  bounding  constants. 

From  (96)  -  (98),  and  (101),  and  that  F(t)E  Coo,  the  expression  in  (119)  can  be  used  with 
the  result  from  [5]  to  prove  that  x(t),xd(t),  xd(t)  G  Too-  Based  on  (39),  and  the  fact  that  M(x), 

M  (£,£), and  F(t)E  Too  then  xd(t)  G  Too-  ■ 


D  Proof  of  Theorem  3 

Lemma  2  Let  the  auxiliary  functions  Lfit),  L2(t)  G  M  be  defined  as  follows 

Li  =  —rT  (P  •FP1sgn{e2)j  (120) 

L2  =  -/32€^sgn{e2) 

where  fi1  and  j32  are  defined  in  (54).  Provided  f31  is  selected  according  to  the  following  sufficient 
condition 


Pi  >  +  ?4, 

where  <^3  and  were  introduced  in  (57),  then 

It0  Li(r)dr  <  £bl  L2(T)dT  <  fb2 

where  the  positive  constants  £61,£62  G  M  are  defined  as 

in  -  PiY.il  I«k(*o)I  -el(to)  (-  F  (to))  Ui-  hYil  K(to)  - 


(121) 

(122) 


(123) 
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Proof.  After  substituting  (44)  into  (120)  and  then  integrating,  the  following  expression  can 
be  obtained 


' to 


't0 


Li(r)dT  =  /  ea(r)  -  F  (t)  -  (31sgn{e2{T)) 


dr 


(124) 


+ 


'to 


del (T) 

dr 


F  (r))  dr -Pi 


'to 


del (r) 

dr 


sgn{e2{r))dr . 


After  evaluating  the  second  integral  on  the  right  side  of  (124)  by  parts  and  evaluating  the  third 
integral,  the  following  expression  is  obtained 


F  (r)+  F  (r)  -  f31sgn{e2{r))^ 


2  n 

- el (t)  F  (t)  -0!  h i(t) |+^i- 

i= 1 


dr 


The  expression  in  (125)  can  be  upper  bounded  as  follows 


rt  2  n 

/  ^2\e2i(r)\  (  Ft  (t) 
'to  i= i  v 

2  n 


+ 


Fi  (t) 


P1 )  dr 


i= 1 


Pi  )  + 


(125) 


(126) 


If  f3j  is  chosen  according  to  (121),  then  the  first  inequality  in  (122)  can  be  proven  from  (126).  The 
second  inequality  in  (122)  can  be  obtained  by  integrating  the  expression  for  L2(t)  introduced  in 
(120)  as  follows 


el(r)sgn(e2(T))dT 


2  n 

<£62-" 

i= 1 


(127) 


The  following  is  the  proof  of  Theorem  3. 

Proof.  Let  the  auxiliary  functions  F\  (t).  P2{t)  G  K  be  defined  as  follows 

Pi(t)  =  ^b  1-  [  Lx(T)dT>  0  (128) 

■Jto 

P2(t)  —  lh2  [  L2(r)dT  >  0  (129) 

dt0 

where  £bl,Li(t),  £b2>  and  L2(t )  were  defined  in  (120)  and  (123).  The  results  from  Lemma  2  can 
be  used  to  show  that  P\(t)  and  P2{t)  are  non- negative.  Let  V\ (y,t)  G  M  denote  the  following 
nonnegative  function 

Vi  =  ^e2e2  +  ^rTr  +  Pi  +  P2  (130) 
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where  y(t)E  R4n+2  is  defined  as 


y(t)  =  [  el  rT  \fP\  VP2  ]T  ■ 
Note  that  (130)  is  bounded  according  to  the  following  inequalities 

W3(y)  KV^t)  <W4(y) 


where 


»3<!/)  =  A4||!/(i)!|2  Wi(y)  =  As  |Mf)||2 

where  A4,  A5  G  1  are  positive  bounding  constants. 

After  taking  the  time  derivative  of  (130),  the  following  expression  can  be  obtained 

Vi  =  -ep 2  ~  k,rTr  -  02elsgn(e2) 


(131) 


(132) 


(133) 


(134) 


where  (44),  (56),  (128),  and  (129)  were  utilized.  The  expression  in  (134)  can  be  rewritten  as 

2  n 

Vi  =  -  || 62 1| 2  -  ks  \\r\\2  -  (32  ^2  le2*l  •  (135) 

i= 1 

From  (130)  and  (135),  it  is  clear  that  V\ (y,t)  G  Coo',  hence,  e2(t)  G  £oonT2n£i,  r(t)  G  £oon£2, 

and  y(t)  G  Coo  .  Since  e2(t),  r(t)  G  £00,  (44)  and  (55)  can  be  used  to  prove  that  e2(t),F  (t)  G  Coo- 

Given  that  e2(t),  r(t),  F  (t)  G  Coo  and  the  assumption  that  Fg  Coo,  (53)  can  be  used  to  prove  that 
r(t)  G  Coo-  Barbalat’s  Lemma  can  be  utilized  to  prove 

||e2(t)|| ,  ||r(t)||  ^  0  as  t  — >  00.  (136) 

From  (44),  (45),  (136)  and  the  fact  that  M(x)  G  Coo,  standard  linear  analysis  arguments  can  be 
used  to  prove  that  e\ (t),  e\ (t),  and  e2(t)  G  Coo,  likewise  that  e\ (t),  e4 (t)  G  £1,  and  that 

||ei(t)|| ,  ||ei(t)||  ,  ||e2(t)||  — ^  0  as  t ->•  00.  (137) 

From  the  fact  that  e2(t)  G  Coo  and  the  assumption  that  F  G  Coo  it  is  clear  from  (51)  that  F(t)  G 
Coo-  Since  F(t)  G  Coo,  (39)  and  the  proof  in  Appendix  C  can  be  used  to  show  that  Xd(t),  Xd(t), 
Xd(t )  G  Coo-  Using  these  facts  along  with  (18)  and  its  first  time  derivative,  it  is  clear  that  x(t) 

and  x(t)  G  Coo-  Since  e\ (t),  e\ (t),  M(x),  M(x)  G  Coo,  it  is  clear  from  (50)  that  Ti(f)  G  Coo,  and 
using  previously  stated  bounding  properties,  T(t)  G  Coo-  It  is  also  possible  to  state  that  Ti(i)  G  £1, 
where  (50)  was  utilized.  Based  on  the  definition  of  x(t)  in  (42)  and  the  previously  stated  bounding 
properties,  it  is  clear  that  \\qi(t)  —  g2(t)||  — 1 >  0  and  q\{t)  +  q2(t)  —a  qd(t).  From  these  bounding 
statements  and  standard  signal  chasing  arguments,  all  signals  can  be  shown  to  be  bounded.  ■ 


E  Proof  of  Theorem  4 

Proof.  Let  Vp2(t)  G  R  denote  the  following  nonnegative,  bounded  function 

kp2  =  \xlMxd  +  -xTdKTXd-  (138) 
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After  taking  the  time  derivative  of  (138),  the  following  simplified  expression  can  be  obtained 

Vp2  =  xdF  -  xdBTxd  (139) 

where  (39)  was  utilized.  Based  on  the  fact  that  Bt  is  a  constant  positive  definite,  diagonal  matrix, 
the  following  inequality  can  be  developed 

VP2  <xTdF.  (140) 

The  following  inequality  can  be  developed  after  integrating  (140) 

-c4  <  Vp2(t)  -  Vp2(t0)  <  f  xd(cr)F(a)da  (141) 

Jt0 

where  c4  G  1  is  a  positive  constant  (since  Vp2(t)  is  bounded  from  the  trajectory  generation  system 
in  (39)). 

To  facilitate  the  subsequent  analysis,  the  following  expression  can  be  obtained  from  integration 
by  parts 


Mei(r)dT  —  Mei(t)  —  Mei(to)  —  /  M  ei(r)dr. 


(142) 


'to 


'to 


Since  M(x),  M  (x,x) ,  e4(t)  G  Too,  and  e4(t)  G  T4,  then  f*  Mei{r)dr  G  Too-  After  integrating  (48) 


as  follows 


F{r)dr  =  —  Mei(r)dT  —  /  Ti(r)dr 


(143) 


'to 


'to 


'to 


and  using  the  fact  that  Tj(t)  G  C\  (see  proof  of  Theorem  3)  and  the  fact  that  f*  Mei(r)dr  G  Too, 
it  is  clear  that  F  G  T4,  where  F(t)  =  F(t )—  F(t). 

By  using  the  transformation  in  (42),  the  expression  in  (5)  can  be  rewritten  as  follows 


<f  (r) 


'to 


F2(t) 


dr  =  xtF  dr  —  /  xjn  0^  F  dr. 


(144) 


'to 


'to 


After  substituting  for  the  definition  of  F(t)  and  the  time  derivative  of  (18)  into  (144)  for  F(t)  and 
x(t),  respectively,  the  following  expression  can  be  obtained 


'to 


xTF dr  -  [  xTdx  0^  ]  Fdr  =  /  iJ2(r)F2(r)dr  +  /  iJ2(r)F2(r)dr 


(145) 


'to 


'to 


'to 


—  /  e^(r)F(r)dr—  /  ef (r)F(r)dr. 


'to 


'to 


Since  xd(t)  =  [  xdl(t )  xd2(t)  ]T  G  Too  and  F(t)  =  [  Ff  (t)  F£ (t)  ]  G  T4,  it  is  clear  that  the 
first  integral  expression  in  (145)  is  bounded  and  from  (143)  a  lower  negative  bound  exists.  Based 
on  (141),  it  is  clear  that  the  second  integral  expression  in  (145)  is  bounded  and  a  lower  negative 
bound  exists.  Since  e4(f)  G  Too  and  F{t)  G  T4,  it  is  possible  to  show  that  the  third  integral  in  (145) 
is  also  bounded  and  a  lower  negative  bound  exists.  Finally,  because  e4(f)  G  T4  and  F(t)  G  Too,  it 
is  possible  to  show  that  the  fourth  integral  in  (145)  is  also  bounded  and  a  lower  negative  bound 
exists.  Hence,  these  facts  can  be  applied  to  (144)  and  (145)  to  prove  that 


nT(  f 

7UW 

/  Q  (t) 

'to 

.  f2<t)  . 

2 

^  °5 


dr  >  — c; 


(146) 


where  C5G  M  is  a  positive  constant. 
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F  Upper  Bound  Development  for  MIF  Analysis 

To  simplify  the  following  derivations,  (27)  can  be  rewritten  as  follows 

N  =  N(x,x,x,e1,e2,r,xd)  =  Mxd  (147) 

+  M1+7  \Cx  +  Bx  1  +  e2 
at  1  J 

.1  /  (cq  T  ol 2)  r  —  iff  T  ctiCt2  T  ®2) 

-  ,  1  - 

fMojei  +  -  M  r 

Zi 

where  (16)  and  (17)  were  utilized.  To  further  facilitate  the  subsequent  analysis,  the  following  terms, 

N(x,  xd,  xd,  0, 0,  0,  xd),  N(x,  x,  xd,  0,  0,  0,  xd),  N(x,  x,  x,  0,  0, 0,  xd).  N(x,  x,  x,  elt  0,  0,  xd)  and 


N(x,  x,  x,  ei,  .  0,  xd)  are  added  and  subtracted  to  the  right-hand  side  of  (26)  as  follows 

N  =  [N(x,xd,xd,0,0,0,  xd)  -  Nd(xd,xd,xd,  0,0,0,  xd)] 

+  [N(x,x,  xd,  0,  0,  0,  xd)  -  N(x,xd,xd,  0,0,0,  x d)} 

+  [N(x,  x,  x,  0,  0,  0,  xd)  -  N(x,x,xd,  0,0,0,  'xd)\  (148) 

+  [N(x,x,x,e i,0,0,  xd)  -  N(x,x,x,  0,0,0,  xd)\ 

+  [N(x,  x,  x,  ei,  e2,  0,  xd)  -  N(x,  x,  x,  eu  0,  0,  xd)] 

+  [N(x,x,  x,  ei,  e2,  r ,  xd)  -  N(x,x,x,e i,e2,0,  x d)} . 


After  applying  the  Mean  Value  Theorem  to  each  bracketed  term  of  (148),  the  following  expression 
can  be  obtained 


N  = 


dN(a1,  xd,  xd,  0,0,0,  xd) 


+ 


+ 


+ 


+ 


+ 


da  1 

dN(x,  cr2,  xd,  0,  0,  0,  xd) 


da2 

dN(x,  x,  cr3, 0,  0,  0,  xd) 


(x  -  xd) 
(x  -  xd) 


cr  2=V2 


da3 

d N(x,  x,  x,  a 4,  0,  0,  xd) 


(x  -  xd) 


cr  3=V3 


da4 

dN(x,  x,  x,  ei,  <75,  0,  xd) 


(ei  -  0) 


cr  4=u4 


da5 

dN(x,x,x,ei1e2la&,  xd) 


&5=V5 


daR 


(e2  -  0) 

(r  —  0) 


(149) 


<JQ=VQ 
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where  vx  G  (xd,x),  v2  G  (xd,x),  v3  G  (xd,  x),  v4  e  (0,ei),  v5  G  (0,  e2),  and  u6  G  (0,r).  The 
right-hand  side  of  (149)  can  be  upper  bounded  as  follows 


N  < 


dN(a1,xd,xd,  0,0,0,  Td) 

<9(7 1 

1 1 

cr  i=v\ 

+ 


+ 


+ 


+ 


+ 


dN(x,a2,xd,  0,0,0,  xd) 


da2 

dN(x,x,c r3,  0,0,0,  xd) 


da  3 

dN(x ,  x,  x ,  cr4,  0,  0,  x'd) 


da4 

dN(x,x,x,ei,a5,0,  xd) 


cr  3=V3 


(7  4=414 


da  5 

dN(x,  x,  x,  e4,  e2,  <76,  'xd) 


<75=V5 


INI 

INI 

Pill 

Pill 

P2II 


da  6 


(T6=V6 


r  . 


(150) 
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The  partial  derivatives  in  (150)  can  be  calculated  from  (147)  as 


By  noting  that 


dN(a1,xd,Xd,  0,0,0,  xd) 

<9<7i 


dN(x,  a2,  xd,  0, 0,  0,  xd) 
da2 


dN(x, 

x,a3,  0,0,0, 

®d) 

da  3 

dN(x, 

x,  x,  a 4, 0,  0, 

®d) 

<9ct4 

dN(x,  x,  x,  ei,  a5l  0, 

®d) 

da5 

dN(x,  x 

,  x,  ei,  e2,  06, 

®d) 

da6 


dM(ai) ... 

— ^ - Xd 

da  i 

d  M  (cr i,  Xd)  .. 

H - 77 - 

acri 

d  C  {<J\,xd,Xd)  . 

H - 77 - xd 

da  i 

dC^ijid) .. 

H - - - xd 


da  i 
d  M  (x,  cr2) .. 


(9  (To 


-Ti 


9  C  (x,  ct2,  xd) 

H - o - °2 

0(7  2 

+  C1  (x,a2,xd) 

dC(x,  a2) .. 

H - 77 - 

0(7  2 

m  {x,i)  +  s_£^iAx 


da3 


—C(x,  x)  +  B 
a\  M(x) 


1  —  a\M(x )  —  ai«2M(x) 
— a\M(x) 

(cti  +  a2)M(x) 

+]-  M  (x,x). 

Zi 


Vi  =  x  -  Cl  (x  -  Xd) 

n3  =  x  -  c3  (x  -  Xd) 
v5  =  e2-  c5  (e2  -  0) 


v2  =  x  —  c2  (x  —  xd) 

V4  =  e\  —  C4  (ei  —  0) 

vq  —  r  c6  (r  -  0) 


(151) 


(152) 


(153) 

(154) 

(155) 


(156) 
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where  c%  G  (0, 1)  Vi  =  1,2,  ...,6,,  if  the  assumptions  stated  for  the  system  model  and  the  desired 
trajectory  are  met,  an  upper  bound  for  the  right-hand  side  of  (151)-(156)  can  be  written  as  follows 


dN(ai,xd,  xd,  0,0,0,  xd) 

d(Tl 

(Tl=Vl 

dN(x,  cr2,  xdl  0, 0, 0,  xd) 

da  2 

O’  2=V2 

dN(x,  x,  cr3,  0,  0, 0,  xd) 

da3 

O’  3=V3 

dN(x ,  x,  x,  a 4,  0, 0,  x'd 

da  4 

O' 4=V  4. 

dN(x,  x,  x,  ei,  cr 5, 0,  xd) 

da5 

°5=V5 

dN(x,  x,  x,  ei,  e2,  cr6,  T fi) 

da6 

oq=v6 

<  Pl(.X,X,x) 

<  P2{x,x,x) 

<  P3(x,x) 

<  fh(x) 

<  PsM 

<  PeO^z) 


(157) 


where  Pj(-)  Vi  =  1, 2, ...,  6,  are  positive  nondecreasing  functions  of  x(t),  x(t),  and  x(t).  After 
substituting  (157)  into  (150),  N(-)  can  be  expressed  as 


N  <  (Pi(||e1|M|e2||,||r||)  +  p4(||e1||))||e1||  (158) 

+  (Pa(l|ei|MM,||r||))||e1|| 

+  (P3(l|ei||,||e2||))||e1|| 

+  (p5(IM))IN| 

+  (P6(l|ei|MM))||r||. 


where  (16)-(18)  were  utilized.  The  expressions  in  (16)  and  (72)  can  now  be  used  to  upper  bound 
the  right-hand  side  of  (158)  as  in  (76). 
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